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Abstract 

In  this  paper,  we  present  a  path  generation  and 
control  strategy  for  a  robotic  manipulator  to 
mimic  the  dynamics  of  a  continuously  reconfig- 
urable  anisotropic  impedance.  Motivated  by  a 
nonholonomic  kinematic  constraint,  a  dynamic 
path  generator  is  designed  to  trace  a  desired 
contour  in  the  robot’s  workspace  when  an  in¬ 
teraction  force  is  applied  at  the  robot’s  end- 
effector.  The  proposed  continuous  control  strat¬ 
egy  achieves  semi-global  asymptotically  stable 
path  following  for  the  robot  manipulator  in  the 
presence  of  uncertainty  in  the  robot  dynam¬ 
ics.  Additionally,  the  path  generator  also  en¬ 
sures  safety  by  maintaining  the  desired  net  flow 
of  energy  during  the  human  robot  interaction 
from  the  user  toward  the  manipulator.  In  addi¬ 
tion  to  providing  asymptotic  path  following,  the 
control  algorithm  also  ensures  sufficiently  rapid 
error  convergence  at  the  end-effector  such  that 
the  actual  energy  transfer  profile  follows  the  de¬ 
sired  energy  transfer  profile  -  thus  rigorously  en¬ 
suring  user  safety.  A  variation  of  the  generation 
and  control  algorithms  is  presented  to  deal  with 
unknown  interaction  force  at  the  end-effector. 

1  Introduction 

Typically,  robots  are  used  for  simple,  repetitive  tasks  in 
structured  environments  isolated  from  humans.  How¬ 
ever,  the  last  decade  has  seen  a  surge  in  active  research 
in  the  area  of  human  robot  interaction.  Bilateral  tele- 
operated  robots  [4,  9,  10,  22],  smart  exercise  machines 
[11,  12],  human  assist  gantry  cranes  [20],  rehabilita¬ 
tion  robots  [3,  8,  13,  14],  and  steer- by- wire  applications 
[16,  17]  are  among  the  multitude  of  application  areas 
that  drive  this  research.  A  common  objective  of  the 
control  algorithm  design  in  all  human  robot  interface 
applications  is  to  rigorously  ensure  user  safety.  Ap¬ 
proaches  based  on  passivity  ensure  that  the  net  flow  of 
energy  during  the  human  robot  interaction  is  from  the 

1  This  work  is  supported  in  part  by  two  DOC  Grants,  an  ARO 
Automotive  Center  Grant,  a  DOE  Contract,  a  Honda  Corpora¬ 
tion  Grant,  and  a  DARPA  Contract. 


user  to  the  machine  [1,  11]. 

The  problem  that  is  dealt  with  in  this  paper  attempts 
to  cast  the  robot  as  a  reconfigurable  passive  exercise 
machine  and  is  inspired  by  the  desire  to  provide  pas¬ 
sive  resistance  therapy  to  patients  affected  by  dystro¬ 
phies  in  the  muscles  of  the  upper  extremities  that  must 
target  specific  groups  of  muscles  in  order  to  regain  mus¬ 
cle  tone  [2].  Along  any  desired  curve  of  motion  in  3D 
space  that  satisfies  a  criterion  of  merit,  motion  is  per¬ 
mitted  against  a  programmable  apparent  inertia  when 
the  user  “pushes”  at  the  end-effector;  force  applied  in 
all  other  directions  is  penalized.  In  the  simplest  sense, 
the  robot  essentially  acts  like  a  “wheel”  (with  program¬ 
mable  inertial  feel  for  the  user)  on  an  arbitrary  smooth 
contoured  rail  that  is  driven  by  the  user  force  at  the 
robot  end-effector.  In  order  to  address  concerns  of  the 
robot  running  out  of  its  workspace  and  into  singular¬ 
ities,  we  allow  for  an  optional  spring  attached  to  the 
“wheel”  that  winds  up  and  down  as  the  “wheel”  ro¬ 
tates  and  provides  for  workspace  dependent  resistance; 
this  ensures  that  a  bounded  interaction  force  leads  to 
bounded  desired  trajectories. 

The  strategy  proposed  in  this  paper  achieves  semi- 
global  asymptotically  stable  path  following  for  an 
n— link  revolute  robot  manipulator  in  the  presence  of 
uncertainty  in  the  robot  dynamics.  Specifically,  given 
a  desired  curve  of  motion  that  optimizes  apriori  estab¬ 
lished  merit  criteria,  we  design  a  generator  based  on 
an  anisotropic  force- velocity  relationship  that  generates 
a  bounded  desired  trajectory  in  the  robot  workspace 
given  the  interaction  force  at  the  end-effector  as  well 
as  generator  parameters  as  the  inputs  into  the  genera¬ 
tor.  The  reference  trajectory  generator  is  carefully  de¬ 
signed  in  order  to  ensure  that  the  relationship  between 
the  interaction  force  and  the  desired  end-effector  ve¬ 
locity  satisfies  a  passivity  constraint.  Next,  a  control 
strategy  is  crafted  using  a  Lyapunov  based  argument  in 
order  to  obtain  the  companion  objectives  of  driving  the 
encl-effector  tracking  error  to  zero  and  ensuring  that  a 
filtered  error  signal  satisfies  an  C\  property.  This  con¬ 
vergence  of  the  filtered  error  signal  allows  us  to  ensure 
that  the  interaction  of  the  user  with  the  robot  is  pas¬ 
sive,  i.e.,  energy  always  flows  from  the  user  to  the  robot 


manipulator.  Additionally,  a  readily  satisfiable  mild  as¬ 
sumption  on  the  differentiability  of  the  robot  dynamics 
allows  us  to  generate  a  control  strategy  that  is  contin¬ 
uous;  this  has  significant  implications  in  terms  of  im- 
plenrentability  of  the  control  algorithm.  As  an  aside, 
the  control  mechanism  has  the  interesting  feature  of 
being  able  learn  the  unknown  robot  dynamics  dynam¬ 
ics.  We  also  present  an  extension  of  our  controller  to 
the  case  when  the  interaction  force  measurement  at  the 
end-effector  is  either  unreliable  or  unmeasurable.  In 
this  case,  we  are  able  to  demonstrate  global  asymptot¬ 
ically  stable  path  following  when  the  robot  dynamics 
are  known. 

This  paper  is  organized  as  follows.  Section  2  of  the  pa¬ 
per  presents  details  of  the  path  generation  algorithm. 
In  Section  3,  we  transform  the  robot  dynamics  into 
a  non-inertial  frame  amenable  to  our  control  design. 
In  Section  4,  we  define  the  error  systems,  measure¬ 
ment  constraints,  and  the  assumptions  under  which  the 
analysis  is  valid.  In  Section  5,  we  present  the  design 
of  the  control  strategy.  Section  6  analyzes  the  stability 
of  the  closed-loop  systems  in  addition  to  demonstrat¬ 
ing  the  accomplishment  of  control  objectives  laid  out  in 
Section  4.  In  Section  7,  we  present  an  extension  of  the 
control  algorithm  to  the  case  of  unmeasurable  interac¬ 
tion  force.  Simulation  results  are  presented  in  Section 
8. 


2  Path  Planning 

In  this  section,  we  set  up  a  reference  generator  to  obtain 
a  desired  trajectory  for  the  motion  of  the  robot  end- 
effector  in  3D  Cartesian  space.  Consider  an  operator 
specified1  desired  curve  of  motion  fd  (s)  €  K3  given  as 
follows 


rd  (s)  =  xd  (s)  i  +  yd  (s)  j  +  zd  (s)  k  (1) 

where  s  ( t )  €  5ft1  is  an  arbitrary  parameter  along  the 
curve,  while  xd(s),  yd(s ),  and  zd(s)  €  5ft1  represent 
the  respective  coordinates  in  an  inertial  frame  T  (say 
fixed  to  the  base  of  the  robot).  Let  vdc  ( t )  €  SR1  be  the 
yet  to  be  chosen  speed  along  the  curve;  one  can  then 
define  the  following  expression  for  s  ( t )  €  5ft1  as  follows 

s  =  Vdc(r'd(s)-f'd(s))~1/ 2  (2) 

Let  T  =  ( u(s )  ,p(s)  ,b(s ))  be  a  rotating  frame2  asso¬ 
ciated  with  the  curve  fd  (s)  such  that 


u(s)  =  ^L 
H)  ft,  Ml 

b  (s)  =  u  (5)  x  p  (5) 


1  For  a  rehabilitation  application,  fd  (s)  would  be  chosen  by 
a  physical  therepist  in  order  for  a  target  set  of  muscles  to  be 
exercised  during  a  particular  therapy  session,  e.g .,  maximizing 
range  of  motion  or  power  output  for  a  target  muscle  set. 

2  The  origin  of  the  frame  T  is  chosen  to  coincide  with  the 

inertial  frame  X. 


We  also  define  the  curvature  k  ( s )  and  torsion  r  (s)  as¬ 
sociated  with  the  curve  as  follows 

«(s)  =  W  (s)|  _ 

T  (s)  =  —p  (s)  •  b'  (s)  ' 

We  next  define  xd(s,t)  €  !ft3  to  be  the  desired  posi¬ 
tion  of  the  robot  end-effector  expressed  in  the  following 
manner 

Xd  =  7<tt«  +  7d2P  +  7d3&  =  r(s)7<i  (5) 

where  T  (s)  =  [  u  (s)  p{s)  b(s)  ]  € 

SO  (3)  is  obviously  defined  and  r)d  (t)  = 

[  ld\  (t)  ld2  ( t )  7d3  (t)  }  e  5J3  denotes  de¬ 
sired  end-effector  position  coordinates  in  T .  By  time 
differentiating  (5)  and  utilizing  (3)  and  (4),  one  can 
obtain  the  following  relationship 

id  =  s  M  x  7 d  +  vd  7 d  (°)  =  pT  (« (A>))  xd0  (6) 

where  [«(s)]x  €  -ft3x3  is  the  antisym¬ 

metric  matrix  associated  with  the  vector 
u(s)  =  [  — r (s)  0  -k(s)  ]T  €  K3,  vd(t)  = 

[  vdi  (t)  vd2  ( t )  vd3  (f)  ] T  €  -ft3  denotes  desired 
end-effector  velocity  coordinates  in  T .  xdo  £  5J3 
denotes  a  suitably  chosen  point  in  the  interior  of  the 
robot’s  workspace,  while  to  denotes  initial  time.  In 
order  to  impose  the  constraint  that  the  desired  robot 
encl-effector  trajectory  xd  (•)  does  not  move  in  the 
direction  of  the  normal  and  the  binormal  to  rd(s), 
we  must  ensure  the  following  nonholonomic  kinematic 
constraint 

Vd2  =  Vd3  =  0  (7) 

In  order  to  enforce  this  kinematic  constraint,  we  imple¬ 
ment  an  asymmetric  impedance  relationship  between 
the  user  applied  force  and  the  desired  encl-effector  ve¬ 
locity  as  follows 

Mrvd  +  Brvd  +  krid  =  Ff  (8) 

where  Mr  =  diag  {mi,  7712,7713}  denotes  a  positive- 
definite  desired  inertia  matrix,  Br  =  diag  {61, 62, 63} 
denotes  a  positive-definite  desired  damping  matrix, 
fcr  €  5J1  denotes  a  non- negative  stiffness  constant, 
Ff  (■ t )  =  [  fu  ( t )  fp  ( t )  fb  ( t )  ] T  €  K3  denotes  the 
user  applied  force  expressed  in  F,  while  7d  (t)  €  K3 
denotes  an  error  signal  that  is  defined  as  follows 

id  =  ld-  rT  (s  (t))  r  (s  (to))  7d  (to)  ■  (9) 

One  can  now  designate  arbitrary  damping  bi  along  the 
tangent  as  well  as  arbitrarily  large  damping  62  and  63 
along  the  normal  and  the  binormal  in  order  to  enforce 
(7).  With  this  choice  of  the  desired  damping  matrix, 
the  desired  speed  of  the  robot  end-effector  along  the 
curve  is  vd\  (t) .  Motivated  by  the  dynamics  of  (8)  and 
the  desire  to  ensure  that  the  motion  along  the  desired 
curve  rd(s)  corresponds  to  the  user  application  of  force 

p.  2 


at  the  end-effector,  we  choose  vdc  (t)  =  Vdi  (t)  such  that 
s  (t)  evolves  according  to  the  following  dynamics 

s  =  Vdi(f'd(s)-f'd(s))~1/2  (10) 

where  (2)  has  been  utilized.  We  note  here  the  special 
case  when  s  is  the  arc  length  parameter,  then  f'  (s)  • 
f'  ( s )  =  1  and  consequentially  s  =  vdi  is  the  speed 
along  the  curve. 

In  order  for  a  user  to  exercise  safely  in  conjunction 
with  the  robot,  the  robot  must  act  as  a  passive  device, 
i.e.,  the  work  done  by  the  user  force  is  always  positive 
(minus  finite  stored  initial  energy  if  any).  With  that 
objective  in  mind,  we  first  demonstrate  that 

f  Ff  •  vddt>  — c2  =>  f  vjFfdt>  —cl  (11) 

J to  J to 

where  F/(t),v  (t)  £  SR3  denote  the  user  force  and  de¬ 
sired  end-effector  velocity  vectors,  respectively,  while 
cf  is  a  bounded,  positive  scalar.  In  order  to  prove  (11), 
we  define  a  Lyapunov  function 

v=  7}vdMrvd  + 7}kr7%7d>0  (12) 

After  taking  the  time  derivative  of  (12)  along  the  de¬ 
sired  dynamics  of  (6)  and  (8),  we  obtain 

V  =  -vjBrvd  +  vjFf  (13) 

where  we  have  utilized  the  definition  of  (9)  and  the  fact 
that  [it  (s)]  is  antisymmetric.  After  rearranging  terms 
in  the  above  equation  and  integrating  both  sides,  one 
can  obtain 

[  vjFfdt  =  V(t)-V  (t0)  +  f  v^Brvddt  (14) 

J to  J to 

After  utilizing  the  fact  that  V  ( t ) ,  vjBTvd  >  0,  we  can 
obtain  an  lowerbound  for  the  left  hand  side  of  the  above 
equation  as  follows 


spring  that  is  unstretched  when  the  desired  robot  end- 
effector  is  at  Xdo;  this  spring  winds  and  unwinds  as 
the  wheel  rotates.  A  properly  chosen  interior  point  xdo 
and  stiffness  kr  ensure  that  a  bounded  interaction  force 
leads  to  desired  trajectories  that  always  lie  inside  the 
robot’s  workspace. 


3  Robot  Dynamics 

The  dynamic  model  for  an  n-link,  revolute  direct  drive 
robot  manipulator  is  assumed  to  be  in  the  following 
form  [19] 

M(q)q  +  Vm(q,q)q  +  G(q)  =  rq  + Fq  (16) 

where  M(q)  £  Rraxn  represents  the  inertia  matrix, 
Vm(q,q)  £  Rnx"  represents  the  centripetal-Coriolis 
matrix,  G(q)  £  R"  represents  the  gravity  effects,  Fq  £ 
rji  represents  the  user  applied  force  expressed  in  joint 
space,  and  rq(t)  £  R™  represents  the  torque  input  vec¬ 
tor. 


The  end-effector  position  in  the  inertial  frame  X,  de¬ 
noted  by  x(t)  £  R3,  is  defined  as  follows 


x  =  f(q)  (17) 

where  f(q)  £  R3  denotes  the  robot  forward  kinemat¬ 
ics,  and  q(t)  £  R"  denotes  the  link  position.  Based 
on  (17),  the  differential  relationships  between  the  end- 
effector  position  and  the  link  position  variables  can  be 
calculated  as  follows 


x  =  J(q)q 
x  =j(q)q  +  J(q)q 


(18) 


where  q(t),  q(t)  £  R"  denote  the  link  velocity  and  accel- 

q  j  (q\ 

eration  vectors,  respectively,  and  J(q)  =  — — — -  £  R3x™ 

denotes  the  manipulator  Jacobian.  After  utilizing  (17) 
and  (18),  one  can  transform  the  joint  space  dynamics 
into  the  task-space  as  follows 

M  (x)  x  +  Vm  (x,  x)x  +  G  (x)  =  tx  +  Fx  (19) 


[  vdFfdt  >  -V  (t0)  =  -c\  (15) 

Jt0 

which  proves  (11).  In  the  sequel,  we  will  show  passivity 
of  the  robot  by  utilizing  (15)  and  the  yet  to  be  proved 
C\  stability  of  the  end-effector  velocity  tracking  error. 

Remark  1  If  kr  of  (8)  is  chosen  to  be  zero,  it  is  pos¬ 
sible  that  the  desired  trajectory  ( t )  might  lie  outside 
the  robot’s  finite  workspace.  In  that  case,  one  may 
constrain  7d  ( t )  to  lie  inside  the  robot  workspace  via 
a  proper  selection  of  initial  conditions  and  the  desired 
curve  rd(s).  If  the  desired  robot  is  chosen  to  have 
non-zero  stiffness,  the  reference  generator  dynamics  de¬ 
scribed  above  constrain  the  desired  robot  to  mimic  the 
motion  of  a  wheel  on  a  contoured  rail  tethered  to  a 


where  M  (•)  =  J+TMJ+,Vm(x,x)  = 

- J+TMJ+jj+  +  J+TVmJ+  £  R3x3  denote,  re¬ 
spectively,  transformed  inertia  and  centripetal-Coriolis 
matrices,  G(x)  =  J+TG  £  R3  represents  gravity 
effects,  Fx  ( t )  =  J+T Fq  £  R3  represents  the  user 
applied  force  expressed  in  X,  rx(t)  =  J+Trq  £  R3 
represents  the  torque  input  vector  expressed  in  X, 
while  J+(q)  £  R"x3  denotes  a  pseudo-inverse  of  the 
manipulator  Jacobian  J(q).  The  relationship  between 
the  end-effector  position  expressed  in  the  coordinates 
of  X  and  T  can  be  expressed  as 

x  =  r  (s)  7  (20) 

where  T  (s) ,  x  ( t )  have  been  previously  defined  and  we 
define  7  ( t )  to  be  the  robot  end-effector  position  coordi¬ 
nates  in  T .  After  utilizing  the  above  relationship,  one 


can  obtain  the  robot  dynamics  in  T  as  follows 

Mf(nr)nf  +  V>(7,7)7  -f  Gf(j)  =  Tf+Ff  (21) 

where  £  5f3x3  denote,  respectively, 

transformed  inertia  and  centripetal-Coriolis  matrices, 
Gf(-)  £  JJ3  represents  gravity  effects,  Ff  (f)  =  TtFx  £ 
5f3  represents  the  user  applied  force  expressed  in  F, 
while  77(f)  =  Tttx  £  5J3  represents  the  torque  input 
vector  expressed  in  T.  Motivated  by  the  subsequent 
stability  analysis  and  control  design,  we  state  the  fol¬ 
lowing  property: 

Property  1:  The  inertia  matrix  Mf(- )  is  symmetric 
and  positive-definite,  and  satisfies  the  following  in¬ 
equalities 

m  IICII2  <  ZTMf  (')  £  <  m( 7)  ll£ll2  €  K3 

_  (22) 

where  m  £  denotes  a  positive  constant,  777(7)  € 
denotes  a  positive  nondecreasing  function,  while 
||-||  denotes  the  standard  Euclidean  norm. 

4  Problem  Formulation 

Given  the  desired  robot  end-effector  trajectory  jd  (t) 
(obtained  via  on-line  solution  of  (6),  (8),  and  (10)),  our 
primary  control  objective  is  to  asymptotically  drive  the 
end-effector  trajectory  tracking  error 

ei  =  ld  -  7  (23) 

to  zero  while  compensating  for  uncertainties  in  the  sys¬ 
tem  dynamics.  Motivated  by  the  subsequent  control 
design  strategy,  we  introduce  additional  tracking  error 
variables  e<i  (t) ,  r  (f)  €  JJ3  as  follows 

e2  —  ei  +  ei  (24) 

r  =  e2  +  62  (25) 

Our  secondary  control  objective  is  to  preserve  the  pas¬ 
sivity  of  the  robot  for  safety  of  user  operation  in  the 
sense  that 

/  vT Ffdt  >  — c2  (26) 

Jto 

where  v(t)  is  the  velocity  of  the  robot  and  Ff(t)  is  the 
interaction  force.  The  control  challenge  is  to  obtain 
the  companion  objectives  mentioned  above  while  uti¬ 
lizing  only  measurements  of  the  end-effector  position, 
velocity,  and  the  interaction  force.  Given  these  mea¬ 
surements,  ei  (f) ,  e2  (t)  are  measurable  variables  while 
r  (f)  is  unmeasurable.  Motivated  by  the  ensuing  con¬ 
trol  development  and  stability  analysis,  we  make  the 
following  set  of  assumptions 

Assumption  1  The  transformed  inertia,  centripetal- 
Coriolis,  and  gravity  matrices  denoted,  respec¬ 
tively,  by  Mf  (•) ,  Cf  (•) ,  and  (?/(•)  are  uncertain 
but  known  to  be  second  order  differentiable. 


Assumption  2  Ff(t)  £  T^  is  a  measurable  interac¬ 
tion  force  at  the  end-effector. 

Assumption  3  The  reference  trajectory  7 d{t)  is  con¬ 
tinuously  differentiable  up  to  its  fourth  derivative 
such  that  7^  £  Too,  i  =  0, 1, 2, 3, 4. 

Assumption  4  The  parameter  s  along  the  desired 
curve  fd  (s)  is  continuously  differentiable  up  to 
its  third  derivative  such  that  sW  g  £ooj  i  = 
0,1,  2, 3. 

Assumption  5  The  skew  matrix  [u]x  is  continuously 
differentiable  up  to  its  second  derivative  such  that 
e  Too,  i  =  0,1, 2. 

Assumption  6  During  the  control  development,  we 
will  make  the  assumption  that  the  minimum  sin¬ 
gular  value  of  the  manipulator  Jacobian,  de¬ 
noted  by  am  is  greater  than  a  known  small  pos¬ 
itive  constant  6  >  0,  such  that  max{||  J+(g)||} 
is  known  a  priori  and  all  kinematic  singulari¬ 
ties  are  always  avoided  (Also  see  Remark  1). 
We  also  note  that  since  we  are  only  concerned 
with  revolute  robot  manipulators,  we  know  that 
kinematic  and  dynamic  terms  denoted  by  M(q ), 
Vm{q,q),  G{q),  x(q),  J(q),  and  J+{q)  are  bounded 
for  all  possible  q(t)  (ie.,  these  kinematic  and 
dynamic  terms  only  depend  on  q(t)  as  argu¬ 
ments  of  trigonometric  functions).  From  the  pre¬ 
ceding  considerations,  it  is  easy  to  argue  that 
M  (x)  ,C(x,x),G  (x) ,  Mf(  7),  Vf  (7, 7),  Gf(  7)  € 
T^  f°r  all  possible  x  ( t ) ,  x  (t) ,  7  (t) ,  7  (t) . 

5  Control  Design 

As  a  primary  step,  we  partially  feedback  linearize  the 
system  by  designing  the  control  signal  r /  (t)  as  follows 

Tf  =  ~Ff+ff-  (27) 

where  77  (t)  €  K3  is  a  yet  to  be  designed  auxiliary  con¬ 
trol  signal  and  we  have  taken  advantage  of  Assumption 
2.  Additionally,  we  simplify  the  system  representation 
of  (21)  by  defining  a  generalized  variable  Bf( 7,7)  €  K3 
as  follows 

Bf  =  (7,7)  7 +  67(7).  (28) 

The  utilization  of  (27)  and  (28)  allows  us  to  succinctly 

rewrite  (21)  as  follows 

Mfj  +  Bf  =  ff.  (29) 

Given  (23-25)  and  (29),  we  can  obtain  the  open- loop 
tracking  error  dynamics  as  follows 

Mff  =  — ^ M/r  —  77  +N 


(30) 


where  N  (•)  €  3ft3  is  an  aggregation  of  unknown  dy¬ 
namic  terms  that  is  explicitly  defined  as  follows 

N  =  Mf('yd  +e'i  +  e2)+  Mf  (77  +  \r  -  ei)  +  e2+  Bf  . 

(3D 

In  order  to  take  advantage  of  the  known  structure  of 
the  uncertainty  in  the  robot  dynamics,  we  can  rewrite 
N  (•)  as  a  sum  of  two  auxiliary  signals  N\  ( t ,  7, 7, 7)  and 
N-2  (z)  as  follows 


6  Stability  Analysis 

Before  presenting  the  main  result  of  this  section,  we 
state  the  following  two  lemmas  which  will  be  invoked 
later. 

Lemma  1  Let  the  auxiliary  function  Lift)  €  3ft  be  de¬ 
fined  as  follows 

Li  =  rT  (Nld  -  /31sign(e2))  ■  (38) 


Mf  (7)  7d  +  M f  (7, 7)7d+  Bf  (li  7, 7) 

A  =  - - v - "  + 

iVi(.) 

M/( 7)(e'i  +  e2)+  Mf  -  ex)  +  e2 

"  na] 

(32) 

where  z(t)  =  [  ef  (t)  ef  (t)  rT  ( t )  ] T  defines  a 
composite  error  vector.  Motivated  by  the  structure  of 
Ni  (•),  we  define  a  desired  variable  Nid  (t)  as  follows 


Nid{t)  =  lV(7d.7d>7d,7d) 

=  Mf[ld)  Id  +  Mf  (7d>  id)ld  (33) 
+  Bf  (7d,7d,7d) 


If  the  control  gain  j3l  is  selected  to  satisfy  the  sufficient 
condition 

^>11^)11  +  11^)11-  (39) 

then 

f  Li(r)dr<Cbi  (40) 

Jt  o 

where  the  positive  constant  £bl  €  3?  is  defined  as 

Chi  =  /?i ||e2 (t0)||  1  -  e%(to)Nld(t0).  (41) 

where  the  notation  ||  •  ||i  denotes  the  C\  norm. 

Proof:  The  proof  is  presented  in  Appendix  B.  ■ 


From  Property  3  and  Remark  4,  it  is  easy  to  see  that 
Nid(t) ,  N\d(t)  €  £00  •  After  adding  and  subtracting 
Nid(t)  to  the  right-hand  side  of  (30),  we  have 

Mff  =  — ^ Mfr  —  e2—  f 7  +N  +  N\d  (34) 

where  N  =  N  —  N\d  is  an  unmeasurable  error  signal. 
After  extensive  algebraic  manipulations  (See  Appendix 
A),  it  can  be  shown  that  N  (•)  can  be  upper  bounded 
as  follows 

JV<p(INI)NI  (35) 

where  the  notation  ||  •  ||  denotes  the  standard  Euclidean 
norm,  p(||z||)  €  3?  is  a  positive  non- decreasing  func¬ 
tion  while  z(t)  €  5ft9  has  been  previously  defined  in 
(32).  Based  on  the  structure  of  (34),  (35)  as  well  as  the 
subsequent  stability  analysis,  we  propose  the  following 
implementable  continuous  control  law  to  achieve  the 
stated  control  objectives 

ff  =  (, ks  +  1)  e2(f)  -  (ks  +  1)  e2(t0) 

+  !t0  [(fcs  +  1)  e2(r)  +  (/?!  +  /?2)sign(e2(r))]  dr 

(36) 

where  ks,/31,/32  are  constant  positive  control  gains.  Af¬ 
ter  taking  the  time  derivative  of  (36)  and  substituting 
for  ff  ( t )  into  (34),  we  obtain  the  following  closed  loop 
system 


Lemma  2  Let  the  auxiliary  function  L2  (f )  €  3ft  he  de¬ 
fined  as  follows 

L2  =  e2  (—p2sign(e2)) .  (42) 

It  is  then  easy  to  show  that 

Jt0  L2(r)dT  =  J*q  ef  (-(32sign{e2))  dr 

=  /ye2(to)||1-/ye2(t)||1  (43) 

<  /?2  II  e2  (^o)  j|  1  —  Ch2 

We  now  state  the  main  stability  result  for  the  proposed 
controller  in  the  following  Theorem. 

Theorem  3  The  control  law  of  (36)  ensures  that  all 
system  signals  are  hounded  under  closed-loop  operation 
and  the  tracking  error  is  asymptotically  stable  in  the 
sense  that 

lim  e^\t)  =0  V  *  =  1,  2;  j  =  0, 1.  (44) 

t— >00 


Proof:  The  proof  is  presented  in  Appendix  C.  ■ 

We  now  turn  our  attention  to  proving  the  passivity  of 
the  robot  manipulator.  Integrating  both  sides  of  the 
bottom  expression  of  (82),  we  obtain 

(  ||e2(r)||1dr  <  =>e2(t)  e  A- 

Jt0  P2 


Mff  =  —\Mfr  —  e2  —  (ks  +  l)r 

-(/?!  +  /?2)sign(e2)  +  N  +  Nld. 


(37) 


Since  e\  (t)  is  related  to  e2  (t)  through  a  transfer  func¬ 
tion  that  is  strictly  proper  and  stable,  one  can  use 
Lemma  A. 8  of  [15]  to  conclude  that  e\ (t)  €  L\.  Now, 
utilizing  (24),  we  can  also  state  that  e\  (t)  €  F\.  Next, 
we  define  the  velocity  tracking  error 

ev=vd-v  (45) 


Assumption  2  Ff(t)  £  £oo  is  an  unmeasurable  inter¬ 
action  force  at  the  end-effector  that  is  second  order 
differentiable. 

Since  Ff{t)  is  unmeasurable,  we  modify  the  desired 
end-effector  velocity  generator  as  follows 


where  vd(t)  has  been  previously  defined  in  (6)  and 
v(t)  £  R3  denotes  actual  end-effector  velocity  coordi¬ 
nates  in  T  such  that 


v  =  j-  s[w]x7- 


(46) 


The  work  done  by  the  interaction  force  on  the  robot  is 
denoted  by  W  (i)  and  given  by 

W  =  f  vTFfdT=  f  uj Ffdr-  f  e^Ffdr  (47) 

J  to  J  to  J  to 

where  (45)  has  been  utilized.  Since  the  first  term  on 
the  right  hand  side  of  (47)  has  been  lowerbounded  as 
in  (15),  we  focus  our  attention  on  the  second  term.  We 
expand  the  second  term  as  follows 


where  we  have  utilized  (45),  (46),  (6),  and  (23).  We 
can  now  upperbouncl  as  follows 


l  Ffdr  < 


sup t  (ll-Py  {t) ||}  Jt0  pi  (t)||i  dr+ 
suPt  {!«(*)  I  ||Nx||}//0  Iki  (r)||id7 


(48) 

where  ei(t),ei(t)  €  F\  has  been  utilized.  Additionally, 
we  have  utilized  Assumptions  3  and  4  to  justify  the  ex¬ 
istence  of  the  supremum  functions  defined  above.  One 
can  now  utilize  the  lowerbound  of  (15)  and  the  upper- 
bound  of  (48)  in  order  to  lowerbound  W  (t)  as  follows 


W  (t)  >  -cf  -c\  =  -c2 


which  satisfies  the  passivity  control  objective  of  (26). 


Mrid  +  BrVd  +  kyjd  =  Ff  (49) 

where  Ff  (t)  is  a  yet  to  be  designed  interaction  force 
observer  while  Mr,  By,  ky  have  previously  been  defined 
in  (8).  We  can  now  utilize  the  dynamics  of  (21)  to  write 
an  expression  for  the  open  loop  tracking  error  dynamics 
as  follows 


M/e 2  =  M/7d  +  M/e i  +  Vf(j,  7)7  +  G/( 7)  —  r/  —  Ff 

(50) 

where  we  have  utilized  the  definitions  of  (23)  and  (24). 
Based  on  Assumptions  1  and  2  as  well  as  the  structure 
of  the  open-loop  dynamics  above,  we  design  the  control 
input  t f  (t)  as  follows 

Tf  =  Mfjd+Mfei+Vf('y,'y)'j+Gf(”/)-Ff+Tfi  (51) 

where  t/i  (t)  €  SR3  is  an  auxiliary  control  signal  that  is 
yet  to  be  defined.  After  substituting  (51)  into  (50),  we 
can  obtain  the  following  expression 

M/e2  =  ~[Ff  -  FfJ  -  Tf 1  (52) 

In  order  to  simplify  the  development  of  the  error  sys¬ 
tem,  we  define  a  measurable  auxiliary  error  variable 
y  (t)  =  Mfe 2-  After  taking  the  time  derivative  of  y  (t) 
along  the  dynamics  of  (52),  we  obtain 

V  =  Mfe 2  -  (-F1/  -  Ff )  -  t/i  (53) 

We  can  now  design  the  auxiliary  input  control  input 
signal  as  t/  1  (t)  =  Mf  (t)  e2  (t)  in  order  to  obtain  the 
tracking  error  system  as  follows 

y  =  -{Ff~  Ff)  (54) 


7  Unmeasurable  Interaction  Force  Extension 

In  this  Section,  we  deal  with  the  important  problem 
of  compensating  for  uncertainty  or  noise  in  the  inter¬ 
action  force  measurements  at  the  robot  end-effector. 
Our  primary  and  secondary  control  objectives  remain 
the  same  as  formulated  in  Section  4.  We  work  under 
Assumptions  3-6  made  earlier;  however,  we  modify  As¬ 
sumptions  1  and  2  as  follows 

Assumption  1  The  transformed  inertia,  centripetal- 
Coriolis,  and  gravity  matrices  denoted,  respec¬ 
tively,  by  Mf  (•) ,  Cf  (•) ,  and  £?/(•)  are  known. 


After  introducing  a  filtered  tracking  error  variable 
r  (t)  =  y  +  ay  (a  a  scalar  gain  constant)  and  taking 
its  time  derivative  along  the  dynamics  of  54,  we  obtain 

r=  -  ^ Ff  -  F f)  +ay  (55) 

where  we  have  taken  advantage  of  the  differentiabil¬ 
ity  of  the  interaction  force.  Motivated  by  our  desire 
to  design  a  continuous  controller,  we  can  design  the 
interaction  force  observation  strategy  as  follows 

F=  -ksr  -ay  -  (/?3  +  /34)  sign(y)  (56) 


where  (33,/34,ks  >  0  are  constant  control  gains.  Since 
r  (t) ,  y(t)  are  unmeasurable,  an  implementable  form  for 
(56)  is  obtained  as  follows 

F  =  (ks  +  a)  y(t0)  -  (ks  +  a)  y(f)_ 

-  Jt0  [(/?3  +  Pi)  sign (y(r))  +  ksay(r)\  dr 

(57) 

After  substituting  (56)  into  (55),  we  can  obtain  the 
following  form  for  the  closed-loop  dynamics 

f=  -Ff  -  ksf  -  (/?3  +  f34)  sign (y)  (58) 

Before  we  delve  into  the  stability  analysis,  we  state  and 
prove  the  following  lemmas. 


Lemma  4  Let  the  auxiliary  function  L3(t)  €  5?  be  de¬ 
fined  as  follows 

£3  =  ~rT  (Pf  +  P3sgn(y)^j  .  (59) 


If  the  control  gain  /33  is  selected  to  satisfy  the  following 
sufficient  condition 


P3  > 


a  1 


(60) 


8  Simulation  Results 


Numerical  simulations  were  performed  to  illustrate  the 
performance  of  the  proposed  reference  generator  and 
control  law  of  (6),  (8),  (10),  and  (36)  with  a  two-link 
planar  elbow  arm  whose  inertia  matrix  M  (y)can  be 
expressed  in  terms  of  its  elements  as  follows 

mu  =  (mi  +  m2)  If  +  m2lf  +  Zmzhk  cos  52 
mi2  =  m2i  =  m2l2  +  m2l\l2  cos  q2  ,  (66) 

m-22  =  7712^2 


while  the  centripetal  Coriolis  vector  can  be  expressed 
in  the  following  manner 


Vm(q,q)q 


— 7712W2  (25132  +  q2)  sin  32 
m2lil2qf  sin  q2 


(67) 


The  mass  and  length  parameters  of  the  manipulator 
are  specified  as  follows 


mi  =  8.339  [kg]  m2  =  0.772  [kg] 
li  =  0.6  [m]  l2  =  0.5  [m] 

The  initial  configuration  of  the  two-link  robot  are  cho¬ 
sen  as 


then 

[  L3(r)dT  <  C&3  (61) 

Jt  0 

where  the  positive  constant  fb3  €  3?  is  defined  as 

Cb3  -  /?3ll^(^o)| |i  -  yT(t0)Ff(t0).  (62) 

Proof:  The  proof  is  similar  as  in  Appendix  B  and 

obtained  by  replacing  Nid(t)  with  —Ff(t).  m 

Lemma  5  Let  the  auxiliary  function  L4(t)  €  3?  be  de¬ 
fined  as  follows 

Li  =  -(3AyT  sgn(y).  (63) 

It  is  then  easy  to  show  that 

J  L4(t )dr  =  J  (-(34yT sgn(y))  dr 

=  Pi\\y(to)\h  -Pi\\y(t)\\i 

<  PiMtofh  =  Cm  (64) 


31  (0)  =  0.2  [rad]  32  (0)  =  0.1  [rad] 

The  desired  contour  is  specified  by  a  unit  circular  path 
Id  ( s )  =  cos  ( s )  i  +  sin  (s)  j.  The  initial  conditions  and 
parameters  for  the  reference  generator  are  chosen  as 
follows 

7d(°)  =  [  0  -1  ]T  H  s(0)  =  0 

Mr  =  diag{  1, 100}  [kg]  Br  =  diag{ 4,  le5}  [Ns-1] 

The  interaction  force  applied  at  the  end-effector  was 
chosen  to  be  Fj  =  [  2  2  ]  [N],  For  best  transient 

performance,  the  control  gains  specified  in  (36)  were 
chosen  to  be  ks  =  100,  =  0.5,  (32  =  0-5.  For  different 

values  of  stiffness,  the  following  two  cases  were  studied: 

Case  1:  When  the  stiffness  is  selected  as  kr  =  1 
[Nm-1],  the  circular  path  can  be  completed  and  re¬ 
peated  with  the  user’s  applied  force.  The  resulting 
task-space  desired  and  actual  manipulator  position  as 
well  as  the  time  histories  of  the  position  errors  are  de¬ 
picted  in  Figure  1  in  Appendix  F.  Figure  2  in  Appendix 
F  shows  the  joint  control  inputs  rq  (t). 


We  are  now  in  a  position  to  state  the  following  theorem. 

Theorem  6  The  observation  and  control  strategy 
given  by  (51)  and  (57)  ensure  the  boundedness  of 
all  system  signals  and  global  asymptotic  tracking 
in  the  sense  that 


Case  2:  When  stiffness  is  selected  as  fcr  =  2  [Nm-1], 
the  circular  path  cannot  be  completed  given  the  lim¬ 
ited  amount  of  applied  interaction  force.  In  Appen¬ 
dix  F,  Figure  3  shows  the  resulting  desired  and  actual 
manipulator  position  and  position  errors.  The  control 
torques  Tq  ( t )  are  depicted  in  Figure  4  in  Appendix  F. 


lim  e*(t),  e*(f)  =  0  V  i  =  1,2  (65) 


Proof:  The  proof  is  presented  in  Appendix  E.  ■ 
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8.1  Appendix  A.  Proof  of  Bound  on  N 

We  start  by  writing  N(t)  from  (31)  and  (33)  as  follows 


N=  [Mfi'y)  -  Mf(jd)}  7d 

+  [m/  (7,7)-  Mf  {id,  id) 


Id 


Bf  (7,7,7)-  Bf  {id,id,id) 


+Mf{  7)(e'i  +  e2) 
+  Mf  (7,7X2  T~ 


ei)  +  e2. 


(68) 


To  simplify  the  notation,  we  define  the  following  aux¬ 
iliary  functions 


^bf  (7,7,7)  =  Bf{  7,7,7) 
$m/(7,7,7d)  -  Mfil,  i)id 


E  =  M/(-)ei+M/(-)e2  +  e2  +  M/(-)^r  — M/(-)ei  (70) 
From  (23-25),  it  is  possible  to  write 


<X  =  e2  —  ei  e2  =  r  -  e2  e1=r  -  2e2  +  e\ 


Given  the  definitions  of  (69)  and  (70),  we  can  rewrite 
(68)  by  adding  and  subtracting  a  bevy  of  terms  as  fol¬ 
lows 

N  =  [Mf{ 7)  -  Mf(ld)\  Id 

+  [$m/( 7,  7,  id)  -  ®mf{ld,  7,  id)} 

+  [$m/(7d,7,7d)  -$m/(7d,7d,7d)] 

+  [$&/(7, 7, 7)  -  $i>/(7d>  75  7)] 

+  E$b/(7d,7,7)  -$fc/(7d>7d>7)] 

+  [$fc/(7d,7d,  7)  -  $b/(7d,7d,  7d)]  +  E- 

(71) 


Given  Assumption  1,  we  can  apply  the  Mean  Value 
Theorem  [6]  to  each  bracketed  term  of  (68)  as  follows 


N  = 


dMf(a  i) 


da  i 


ei  Id 


l<Tl=^i 

<9$m/(cr5,7,7d) 


+ 


+ 


+ 


+ 


da-2 
7dW3,7d) 


da3 

d*&bf{a4, 7i  7) 


ei 


ei 


9tT4 

d$&/(7<iW5,7) 


ei 


da5 

d^bfhd,7d^e) 


el 


<75=^5 


ei+E 


r76=<t6 


(72) 


where  ci(t),  <?2 (t),  u(t)  £  (7,7d),  ^(/UsW  £  (7,7^) 
while  C6(f)  €  (7,7 d).  From  the  preceding  analysis,  the 
right-hand  side  of  (72)  can  be  succinctly  expressed  as 


N  =  $z. 


(73) 


where  z(t)  £  R9xl  is  the  composite  error  vector  that 
has  previously  been  defined  and  $(7,7,7,^  €  M3x9 
is  the  first-order  differentiable  system  regressor.  By 
virtue  of  its  first-order  differentiability,  $  (•)  can  be  up- 
perbounded  as  follows 


$(7.7,7,*)  <  P(7,7,7)  (74) 

where  p  (•)  is  a  positive  function  nondecreasing  in 
7 (t),  7  ( t ) ,  and  7  ( t ).  Given  Assumption  3,  we  can  uti¬ 
lize  (74)  and  the  facts  that 


7  =  Id  ~  ei 
7  =  id  ~  e2  +  ei 
7  =  Id  ~  r  +  2e2  -  ei 

in  order  to  upperbound  N  (•)  as  follows 

^p(INI)NI 

where  /9(||z||)  is  some  positive  function  nondecreasing 
in  ||*||  . 


9  Appendix  B:  Proof  of  Lemma  1 


After  substituting  (25)  into  (38)  and  then  integrating 
in  time,  we  obtain 

Jt0  L{t)cLt  =  /*  el (r)  (Nld{r)  -  /31sgn(e2(r)))  dr 
+  fld4^Kld(T)dT 
~0i  /to  ^S^sgn (e2(r))dr  . 

(75) 

After  integrating  the  second  term  on  the  right-hand 
side  of  (75)  by  parts,  we  obtain  the  following  simplified 
expression 


Jto  L4)dr  = 


/t*  e2  (r)  ( Nid(r ) 

_  d.N^ Ld(r)  __  ^iSgn(e2(T))^  dr 

+e2  (t)Nld(t)  -  e/ (t0)Nld(t0) 
— /?i||e2  (f)  ||i  +/3i||e2(f0)  ||i  . 


(76) 


We  can  now  upper  bound  the  right-hand  side  of  (76) 
as  follows 


//oL(r)dr<  /t* 

+ 

+1 


le2  (t)  I 

dNid(r) 


dr 

e2  Will 

+/3i||e2  (to) 


(l|iVld(r)|| 


dr 


/?i) 


(HJVwWII-^) 

-  e2  (to)^V'id(to)  • 


(77) 

From  (77),  it  is  easy  to  see  that  if  is  chosen  according 
to  (39),  then  (40)  holds. 


10  Appendix  C:  Proof  of  Theorem  3 


Let  us  define  two  auxiliary  functions  Piit)  £  5J  as  fol¬ 
lows 

Pi(t)  4  (bt  -  [  Li(r)dT  >  0  V  i  =  1, 2  (78) 

Jto 

where  Cbi4i(t)  have  been  previously  defined  in  Lem¬ 
mas  1  and  2.  Based  on  the  non-negativity  of  P;,  (t) 
above,  one  can  define  a  nonnegative  function  V(t)  as 
follows 

V  =  Tjefei  +  ^e/e2  +  ^ rTMfr  +  Pi  +  P2  (79) 


After  taking  the  time  derivative  of  (79)  and  utilizing 
the  definitions  of  (23-25)  as  well  as  the  closed-loop  dy¬ 
namics  of  (37),  we  can  conveniently  rearrange  the  terms 
to  obtain  the  following  expression  for  V  ( t ) 


V  = 


HNI2HN|2-(k  +  l)||r||2 
+el e2  +  rTN  -  fd2el sgn(e2 ) 

+  rT  (Nld  -  (3: Lsign(e2))  -  Lx] 
-  e//32sign(e2)  +  L2\ 


(80) 


where  we  have  utilized  the  definition  of  (78).  After 
utilizing  the  definitions  of  (38)  and  (42)  to  eliminate 
the  bracketed  terms  in  the  above  equality,  we  can  utilize 
simple  algebraic  manipulations  to  obtain  the  following 
upperbound  for  V  (t) 


V<-l\\z\\2  +  [\\r\\p(\\z\\)\\z\\^kM2]  -/J2IMI1 


where  z  (f)  is  a  composite  error  vector  that  has  been  de¬ 
fined  previously  in  (32).  Applying  the  nonlinear  damp¬ 
ing  argument  [7]  to  the  bracketed  term  above,  we  ob¬ 
tain  the  following  upperbound  for  V  ( t ) 


2  ks  ) 


/^2  11^2  ||  1 


(81) 


From  (81),  it  is  possible  to  state  that 


-<x\\z\\ 
-02  IN 


for  k. 


>  t2p\\\4) 


(82) 


where  a  £  SR  is  some  positive  constant  of  analysis.  We 
note  here  that  it  is  possible  to  express  the  lowerbound 


on  ks  in  terms  of  the  initial  conditions  of  the  problem 
which  has  been  referred  to  in  literature  as  a  semi-global 
stability  result.  We  refer  the  interested  reader  to  Ap¬ 
pendix  D  for  the  details  of  such  a  procedure.  Here 
onward,  our  analysis  is  valid  in  the  region  of  attraction 
denoted  by  Clc  in  (86).  From  (82)  and  the  analysis  in 
Appendix  C,  it  is  easy  to  see  that  2  (t)  €  £00  n  £2  and 
lim  || 2:|| 2  =  0.  From  the  previous  assertions  and  the 

t — »oo 

definitions  of  (24),  (25),  and  (32),  one  readily  obtains 
the  result  of  (44). 


11  Appendix  D:  Calculation  of  Region  of 
Attraction 


Following  [21],  we  now  define  the  region  of  attraction 
for  the  system.  From  (82),  we  obtain  the  following 
sufficient  condition  for  the  negative  definiteness  of  V  (t) 


11*11  <p-\VZks)  (83) 

Next,  we  define  77  (t)  = 

[  zT  (t)  \fP\  (t)  y /P2  (t)  }T  <5  K11  and  a 

region  Q  in  state  space  as  follows 

£2  =  {77  e  M11  |||77||  <p-\JWs)}  (84) 


where  the  definition  of  ?/  (t)  indicates  that  fi  is  a  subset 
of  the  space  defined  by  (83).  Based  on  Assumption  3 

in  Section  4,  we  define  6 1  —  77  min{l,m}  and  <*>2(7)  — 

max  |-m(7),  1 1;  thereby,  (79)  can  be  upper  and  lower 
bounded  as 

UV)<V<UV)  (85) 

where  £1  (77)  =  64  IMI2  €  5J  and  £2 (v)  =  ^2(7)  IM|2  € 
5J.  From  the  boundedness  conditions  above,  we  can 
further  find  an  estimate  for  the  region  of  attraction  of 
the  system  as 


nc  =  1 77  e  n  £2(77)  <  1(V^k~s))2 } 


(86) 


Given  (85)  and  (82),  we  can  invoke  Lemma  2  of  [21]  to 
state  that 


Given  the  definition  of  77(f),  we  can  write 

!!??(£>)  ||  =  (ef  (to)ei(to)  +  el  (f0)e2(fo) 

+  [^2  (to)  +  e2(to)]T  [e2(to)  +  e2(to)\ 

+£>i(£o)  +  £2(^0)) 2 

(91) 

where  we  have  utilized  the  definitions  of  z  ( t )  and  r  (t) 
from  (32)  and  (25).  From  (41),  (43),  (23),  and  (29),  we 
can  obtain  the  following  expression 


62 (fo)  =  7 d(to)  +  id(to)  -  7(fo) 

+M^1(7(f0))%(7(fo),7(fo))  • 


After  substituting  the  above  expression  into  (91),  we 
can  finally  express  1 1 77(20)  1 1  in  terms  of  system  initial 
conditions  as  follows 


IWto)||  = 


'ef  (fo)ei(fo)  +  el  (t0)e2(t0) 

7d(t0)  +M/'1(7(t0))R/(7(to),7(fo)) 

+7d(to)  -7(fo)  +  e2(to)||2 
+/?i  II 62 (£0) ||i  -  el (to)Nld(to) 

"b/^2 11^2  (fo)  II  l)1^2  • 

(92) 


12  Appendix  E:  Proof  of  Theorem  6 

To  prove  this  theorem,  we  utilize  the  following  non¬ 
negative  function 

V  =  ^ rTf  +  P3  +  P4  (93) 

where  the  two  auxiliary  functions  Ps(t),P4  (f)  €  5?  are 
defined  as  follows 


Pi{t)  4  Cbl  -  [  Li(T)dT  >  0  V  i  =  3,4  (94) 

Jt0 

After  taking  the  time  derivative  of  (93)  along  (58),  we 
can  upperbound  V  (f)  as  follows 

V  (t)  <  -fcs||f||2  -d/34||y||i 


lim  |;j||2  =  0  V  ??(to)  €  flc  ■  (87) 

t — >00 

From  (86),  we  require 

£2 (»?  W)  <  (88) 


which  implies  that  we  can  write  (88)  in  terms  of  system 
initial  conditions  as  follows 


W*o)||  < 


62(7^0)) 


p  1{^jzks), 


(89) 


where  we  have  taken  advantage  of  the  fact  that  V  (t) 
is  either  decreasing  or  constant  for  all  time.  We  can 
rewrite  (89)  in  terms  of  an  lowerbound  on  ks  as  follows 

ks>lp2(^^^Hto)\\).  (90) 


where  we  have  utilized  the  definitions  of  (59),  (63),  and 
(94).  It  is  now  easy  to  show  that  f(t),y  (t)  €  £oo  H  £2. 
From  the  previous  assertions  and  the  definitions  of  (24) 
and  (25),  we  can  now  use  Lemma  A. 8  of  [15]  to  state 
that  ei  (t) ,  e\  ( t ) ,  e2  (t) ,  e2  (f)  €  £1  n  £00  •  Given  these 
assertions  and  some  signal  chasing  akin  to  the  proof  of 
Theorem  3,  we  can  obtain  the  control  objectives  tar¬ 
geted  in  Section  4. 
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13  Appendix  F:  Simulation  Plots 


Desired  and  Actual  Task-Space  Trajectories 


Task-Space  Errors 


Figure  1:  Workspace  Trajectories  and  Errors  :  fcr  ~  1 


Joint  Space  Torque  Trajectories 


Figure  2:  Robot  Joint  Torque  Inputs:  fcr  =  1 


Desired  and  Actual  Task-Space  Trajectories 


Task-Space  Errors 


Figure  3:  Workspace  Trajectories  and  Errors  :  fcr  =  2 


Joint  Space  Torque  Trajectories 


Figure  4:  Robot  Joint  Torque  Inputs:  fcr  =  2 
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